float32[7] joint_pos
float32[7] joint_dev
float32[7] joint_cur
int32 mode